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1. Introduction : 

Le filtrage est la mise en forme d'un signal a des fins tres diversifies. Pendant longtemps son role a 
consiste surtout dans 1' elimination des bruits superposes aux signaux utiles et sa mise en oeuvre a 
ete du ressort des electroniciens. 

Apres Pavenement de Pautomatique et des calculateurs numerique, le filtrage est devenu un outil 
fondamental. II garantit l'equivalence analogique -numerique. Une fois la conversion numerique 
obtenue, le filtrage permet l'extraction d' informations utiles pour la reconnaissance des formes dans 
Pelaboration de la loi de commande des systemes industriels. 

II existe deux especes de filtrage appelees le filtrage frequentiel et le filtrage optimal. Le filtrage 
frequentiel comporte lui-meme deux fonctions : le filtrage analogique et le filtrage numerique. Le 
filtrage analogique demeure un element indispensable dans la synthese des filtres numeriques et un 
moyen de reduction de la bande passante pour le codage des signaux continus. De meme, le filtrage 
numerique resoudre le probleme de la mise en forme d'un signal et permet de realiser 
P interpolation et P extrapolation, et peut etre un filtre passe bande. 

Le filtrage optimal admet deux theories importantes appelees theorie de Wiener et theorie de 
Kalman. 

En 1950, Wiener a developpe sa theorie en traitant seulement les signaux stationnaires sous leur 
forme frequentielle. II resoudre le probleme de P elimination du bruit parasite inherent a la 
transmission et fait de Pestimation. Son inconvenient reside dans le non recursivite, ce qui rend un 
peu difficile la rapidite du systeme. 

En 1960, une theorie s'est developpee, dite theorie de Kalman, qui est une extension de la theorie de 
Wiener et represente plusieurs avantages. 

Filtre de Kalman : Le filtre de Kalman represente une extension de la theorie de Wiener 
applicable aux signaux non stationnaires sous leur forme temporelle en presence des conditions 
initiales et d' entrees deterministes. II resout le probleme de filtrage lineaire et se presente sous la 
forme d'un ensemble d'equations recurrentes plus faciles a resoudre sur calculateur numerique, ce 
qui explique le succes remarquable de Papproche proposee par Kalman. Sa realisation fournit non 
seulement Pestimee optimale, mais aussi la variance de Perreur de Pestimation. C'est un 
observateur donnant la prediction ou Pestimation du vecteur d'etat. Lorsque les variances des 
bruits sont connues, c'est le meilleur observateur lineaire, de plus, si les bruits sont blancs 
gaussiens, lineaires ou non, c'est lui dont la variance de Perreur d'estimation est la plus faible. 

Le filtre de Kalman s' applique au systeme dynamiques lineaires, connus ou discrets, ont le bruit de 
mesure est blanc. 

L'estimation de Kalman et ses nombreuses derivees ont ete developpee avec succes dans le monde 
de Paerospatial a de nombreux problemes, comme la poursuite radar, l'estimation de trajectoires 
d'orbites... [1] 

Apres la parution des publications fondamentales de Kalman et Bucy pour la theorie de filtrage 
lineaire, un nombre tres important de travaux fut consacre a ce probleme, chaque auteur decrivant 
son algorithme en exploitant des methodes comme les moindres carrees, le maximum de 
vraisemblance et d'autres methodes statistiques classiques. Cependant, ces methodes statistiques 
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laissent dans l'ombre la structure probabiliste du probleme de filtrage, structure qui est 
fondamentale. [2] 

2. Derivation du filtre de Kalman : 

2.1 Formulation du probleme : 

Le filtre de Kalman est caracterise par les mesures qui sont generes par un systeme dynamique qui 
est presente par un certain modele [7]. Mathematiquement le filtre de Kalman peut etre formule par 
deux equations : 

L'equation d'etat, qui presente revolution d'etat d'un objet durant le temps et l'equation de mesure, 
qui relie les mesures a cet etat. 

Nous considerons un systeme dynamique lineaire et discret, l'equation d'etat est donnee par : 
x k +i = FkX k + G k u k + w k (1.1) 

> x k est le vecteur d'etat qui incluse les quantites a estimer, comme la position, la vitesse et 
l'acceleration. 

> F k est la matrice de transition. Elle decrit revolution dans le temps du vecteur d'etat, en 
absence de l'entree de controle et du bruit. 

> u k est l'entree de controle ou le processus generateur, elle est supposee etre connue. 

> G k est une matrice qui decrit comment l'entree a l'instant k, contribue au vecteur d'etat a 
l'instantk+1. 

> w k est le bruit de processus suppose independant, blanc et de moyenne nulle. 



X(k) 



H 



Parametres de 
bruit 




Observation z(h) 



Bruit blanc additif v(k) 



Figure 1.1 : Modele d'observation 



z k = H k x k + v k 

Ou 

> H k est la matrice de mesure. 

> v k est le bruit de mesure suppose independant de w k , blanc et de moyenne nulle. 



(1.2) 
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E[w k ] = (1.3) 

E[v k ] = (1.4) 

E[v kWl T ] = 0; V k, 1 (1.5) 

E[w kWl T ] = Q k S(k, 1) (1.6) 

E[v kVl T ] = R k S(k, 1) (1.7) 

et 

E[x wJ] = V k (1.8) 

E[x vJ] = Vk (1.9) 

Q k et R k etant respectivement les matrices de covariance du bruit de processus et du bruit de 
mesure. 

Le probleme consiste a estimer le vecteur d'etat x k compte tenu des informations disponibles a 
l'instant n, posterieur, anterieur, ou identique a l'instant k. 

On peut considerer les cas suivants: [2] 

• k=n: il s'agit dans ce cas de determiner une estimee de l'etat, compte tenu de toutes les 
mesures disponibles a l'instant considere n. c'est le cas du filtrage. 

• k<n: en utilisant les mesures disponibles jusqu'a l'instant n, on essaye d'estimer l'etat a un 
instant k anterieur a n. on fait alors un lissage ou une interpolation. 

• k>n: il s'agit dans ce cas d'estimer la valeur du vecteur d'etat a un instant k dans le futur. 
c'est ce qu'on appelle la prediction ou l'extrapolation. 

Nous noterons pour ces differents cas, l'estimee par: X k +i/ n , c'est a dire l'estimee a l'instant k+1 
compte tenu des informations disponibles a l'instant n. 

L'estimee optimal au critere de l'erreur quadratique moyenne minimale est donnee par l'esperance 
mathematique conditionnelle notee comme suit: [5] 

Xk+l/n = E[x k+1 /Z! Z n ] (1.10) 

L'evolution du vecteur d'etat estimee Xk+l/n ? est caracterisee par la matrice de transition F k . En 
effet en substituant l'equation (1.1) dans (1.10), on obtient: 

E[x k+ i/z! z k ] = F k E[x k /z 1 ,...,z k ] + G k E(u k+1 /z L , „.,z k ] + 

E[v k+ i/z b ... , z k ] (1.11) 
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Soit encore : 

Xk+i/k = Fk x k/k + G k u k (1.12) 

Etant donne que : 

rv k +i 



z(D 



z k 



= (1.13) 



l'objectif est d'avoir une estimation recursive du vecteur d'etat qui, a partir d'une estimation a 
l'instant k, nous fournisse une nouvelle estimation a l'instant k+l,en utilisant la mesure a cet instant. 
On adoptera une estimation lineaire de la forme: 

^k+i/k+i — x k +i/k + K k+1 [z k+1 — H k+1 x k+ 1/k J (1.14) 

La relation (1.14) exprime le fait que la nouvelle estimee du vecteur d'etat a l'instant k+1, est une 
mise a jour de l'estimee a l'instant k. cette mise a jour tient compte de l'ecart entre la mesure 
effective et la mesure predite. 

Nous devons done determiner le poids K k+1 a accorder a cette mise a jour de sorte que l'erreur au 
sens des moindres carres, entre le vecteur d'etat et son estimee, soit minimale. Le parametre K k+1 
est appele gain du filtre de Kalman. 

L'erreur d'estimation est definie par: 

^k+i — x k+i ~~ ^k+i/k+i (1-15) 

II s'agit done de minimiser la quantite: 

P k+l/k+l - E [( x k+1 ~~ x k+ l/k+l)( x k+l ~ x k+ 1/k+l) ] = E [ x k+l x k+lJ (1-16) 

Pk+l/k+1 est appelee matrice de covariance de l'erreur d'estimation. Le filtre de Kalman est done 
un filtre a minimum de variance. C'est par abus de langage que Ton parle de minimiser cette 
quantite matricielle. Nous y reviendrons dans le prochain paragraphe. 

2.2 Expression de la matrice de covariance : P k+ i/ k+ i [5] 

Nous allons, a partir des equations d'etat et de la relation lineaire de l'estimation exprimer la matrice 
de covariance P k+ i/ k+ i en fonction du gain K k+ i- 

Reprenons les relations (1.1) et (1.12). 
x k +i = FkX k + G k u k + w k 
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Xk+l/k — Fk *k/k + G k U k 
En les soustrayant, il vient: 

x k+1 - x k+1/k = F k [x k - x k/k ] + w k (1.17) 

D'apres la relation (1.16) definissant P k +i/k+l> on a: 

Pk+i/k = E[(x k+1 - x k+ i/k)(x k+1 - x k+ 1/k ) T ] (1.18) 

D'ou, en prenant les esperances mathematiques des deux membres de l'equation (1.17) 

Pk+i/k = F k E[(x k - x k/k )(x k - x k/k ) T ]Fj + E[(w k wJ)] (1.19) 

Cette relation peut se simplifier en tenant compte de la relation (1.6) et du fait que: 

E[(x k+ i - x k/k )(x k+1 - x k/k ) T ] = P k/k (1.20) 

II vient alors: 

P k+l/k = Fk P k/k F k + Qk (1.21) 

Nous devons a ce stade du calcul exprimer P k +i/ k +i en fonction de P k +i/ k . 

Pour ce faire, reprenons l'expression (1.15) de l'erreur X k+ ^et rempla?ons l'estimee X k+ ^ / k+ ^ par 

son expression donnee par la relation (1.14), on obtient: 

x k +i/ k +i = x k+1 — x k+1 / k — K k+1 [H k+1 x k+1 + v k+1 — H k+1 x k+ !/ k J 

= - K k+1 H k+1 )(x k+1 - x k+ 1/k ) - K k+1 v k+1 (1.22) 

° u p k+i/k+i - E [x k +i/k+iX k +i/ k +iJ (1.23) 

Si on substitue l'expression (1.22) dans la relation (1.23), il vient en tenant compte de la relation 
que: (AB) T = B T A T que : 

P k+l/k+l — _ K k+lH k +i)E[(x k+1 — X k+1/k )(x k+1 -X k+1/k ) ](I — K k+1 H k+1 ) 

+ K k+1 E[v k+1 vJ +1 ]Kj +1 (1.24) 

Soit encore: 

p k+i/k+i = — K k+ iH k+1 )P k+ 1/k (I — K k+1 H k+1 ) + K k+1 R k+1 K k+1 (1.25) 
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Pk+l/k+l — Pk+l/k ~~ K k+1 H k+1 P k+1/k — Pk+l/kH k+ iK k+1 + 

Kk+i[H k+ iP k+ i/ k+ iH k+1 + R k +i]K k+1 (1.26) 

2.3 Expression du gain du filtre de Kalman: [5] 

Nous devrons chercher l'expression du gain K k+ i qui minimise le critere 

J = E K + i/ k +iXk+i/k+i] (1-27) 

Notons au passage que nous avons: 

Trace P k+1/k+1 = E|x k+ i/ k +iX k+1/k+1 ] = J (1.28) 

La relation (1.26) est une forme quadratique en K k+ i- Nous obtiendrons la valeur du gain optimal 
en resolvant l'equation suivante: 

aj(k) 
= o 

3K(k) 

L'optimisation de ce probleme peut etre faite de differentes manieres. L'une de ces manieres se base 
sur les formules du calcul differentiel des matrices. En utilisant les relations suivantes: 

a(Trac ; A (AB)) = B T (AB doit etre carre) (1.29) 

a(Trace(ACA T )) 

— = 2AC (C doit etre symetrique) (1.30) 

ok 

On obtient 

a(TraceP k+1/k+1 ) _ 

— --2(H k+1 P k+1/k ) + 

2K k+1 (H k+1 P k+1/k H k+1 + R k+ i) (1.31) 

Soit encore : 

_ _ K k+1 H k+1 )P k+1/k H k+1 + K k+1 R k+1 = (1.32) 

D'ou 

K k+i - p k+i/kH k+ i[H k+1 P k+1/k H k+1 + R k+ i]~ (1.33) 

Et 
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Pk+l/k+l — Pk+l/k ~~ Pk+ l/kHk+iHk+iPk+ l/k^k+i + Rk+iHk+iPk+ 1/k (1-34) 

Dans le cas continu, cette equation prend la forme d'une equation differentielle de Ricatti. 

C'est pour cette raison, et par analogie que la relation (1.34) est appelee equation de Ricatti 
discrete. 

Elle peut etre reecrite sous la forme suivante: 

Pk+l/k+l — Pk+l/k ~~ K k+ iH k+ iPk+i/k — [I — K k+ iH k+ i]Pk+i/k (1.35) 

La matrice Kk+iHk+iPk+i/k est definie positive ou a la rigueur definie semi-positive. 
Nous pouvons en outre ecrire l'equation recursive de mise a jour de l'estimation comme suit: 

x k+ i = x k + K k [terme de correction] (1.36) 

II apparait ainsi que: 

1. Pour R k+1 constant, si P k+1 faible, le gain sera faible. Ainsi, on fera davantage confiance a 
l'estimation obtenue a partir du modele. Si par contre P k+1 est eleve, ce qui traduit notre 
faible confiance dans le modele K sera eleve et la contribution du terme de correction 
pondere par le gain, sera plus forte. On se basera done davantage sur les mesures pour la 
mise a jour. 

2. Pour P k+1 constant, si R k+1 est faible, nous aurons des mesures faiblement bruitees. La 
valeur elevee du gain donnera plus de poids aux mesures. Si R k+1 est eleve,le gain sera 
faible et le poids du deuxieme terme sera plus faible. 

2.4 Initialisation du filtre de Kalman: [3] 

Pour pouvoir utiliser l'ensemble des equations recurrentes constituant le filtre de Kalman, on doit 
choisir les conditions initiales: Xq/o et Po/o-On peut prendre: 

x 0/ o = E[x ] (1.37) 

Po/o = Po = E[x - x 0/0 )(x - x„/o) ] (1-38) 

Le choix des valeurs initiales est delicat. En effet, un mauvais choix de x , c'est a dire, a la limite 
une valeur arbitraire n'est pas catastrophique en ce sens que l'algorithme excite par les mesures 
apportera les corrections necessaires. Par contre le traitement des mesures n'ameliore pas la 
covariance de l'erreur au fur et a mesure de son traitement. 

2.5 Notion d'innovation: [5] 

Reprenons l'equation (1.14) de l'estimation recursive: 
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^k+l/k+l — ^k+l/k + K k+1 [z k+1 — H k+1 x k+1/k ] 

z k+1 represente la mesure effective et H k+ ^X k+ i/ k la prediction de la mesure. Si cette prediction 
est prediction est parfaite, la correction apportee par la quantite 

Zk+i - z k+i ~~ H k+1 x k+1/k (1.39) 

sera nulle. On appelle z k+1 l'innovation. On peut montrer que si le filtre est optimal, le processus 
z k+1 est un bruit blanc de valeur moyenne nulle, c'est a dire qu'il ne contient plus d'informations 
pouvant enrichir la mise a jour de l'etat. 

Ainsi, en testant la « blancheur » de l'innovation on peut apprecier le degre d'optimalite et done les 
performances du filtre. 

3. Mise en oeuvre du filtre de Kalman [2] 

On peut resumer l'ensemble des equations recurrentes constituant le filtre de Kalman dans les etapes 
suivantes : 

3.1 Prediction: 

1. A partir du vecteur d'etat a l'instant anterieur, la prediction du vecteur d'etat est 
effectuee selon: 

x k+ i/ k = F k x k/k + G k u k (1.40) 

2. Calcul de la matrice de covariance correspondant a l'etat predit: 

P k+ i/k = F k Pk/kFj + Qk (1-41) 

3.2 Estimation: 

1 . Mise a jour du vecteur d'etat: 

^k+i/k+i — x k+ i/ k + K k+1 z k+1 (1-42) 

Ou z k+1 est l'innovation definie en (1.39) et K k+1 est le gain de Kalman donnee par: 

K k+1 - P k+l/kH k+ iS k+1 (1-43) 

S(k + 1) est appelee matrice de covariance de l'innovation. Elle est donnee par: 

Sk+i - H k+1 P k+1/k H k+1 + R k+1 (1.44) 
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2. Mise a jour de la matrice de covariance de l'etat estime 
la matrice de covariance correspondant a (1.42) est calculee selon: 



P k+l/k+l — P k+l/k — K k+lSk+l K k+1 



(1.45) 



On peut resumer l'algorithme de filtre de Kalman dans le cycle suivant en cinq etapes de base qui 
sont: 

> Extrapoler la position et la vitesse de la cible. 

> Extrapoler les erreurs d'estimation 

> Calculer le gain du filtre. 

> Mettre a jour l'estimation de vecteur d'etat. 

> Mettre a jour l'estimation pour les nouvelles donnees (mesure). 

Le schema de la figure 1.2 resume un cycle de calcul de l'etat estime d'un systeme lineaire par le 
filtre de Kalman. 



^k+i 



z k+i 






?^ 



Entrees 



K 



k+1 



•e> 



Zk+l/k 



x k+l/k 



H k+l ■* 



<8> 



_ 



u k 



X k+I/k+l 

Z ' 



Soitle 



^k/k 



Figure 1.2 : Un cycle pour l'estimation de l'etat d'un systeme lineaire (filtre de Kalman) 



4. Les modeles cinematiques : 

Les modeles d'etat cinematiques sont definit par la mise de quelques derivations de position a Zero. 
II existe deux modeles: modele de deuxieme ordre (white noise acceleration) et le modele de 
troisieme ordre (Wiener process acceleration). [6] 

4.1 Modele a vitesse constante (deuxieme ordre) 

Ce modele est plus adapte au mouvement d'une cible qui se deplace a une vitesse constante. Un 
objet deplace avec une vitesse constante, son mouvement est presente par l'equation: 

x k = 
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La position evolue, en absence du bruit, selon un polynome (dans ce cas de ordre), ce modele est 
appele le modele polynomiale. En pratique, la vitesse subit des changements aleatoires, qui peuvent 
etre modelises par un bruit blanc d moyenne nulle. 

Si on suppose que la poursuite se fait dans un plan (X,Y), le vecteur d'etat relatif a la direction x 
sera forme de deux composantes qui sont la position et la vitesse dans cette direction: 

x k = [x, *] T (1.46) 

L'equation d'etat pour un filtre de Kalman du deuxieme ordre est: 

x k +i = FkX k + G k u k (1.47) 

La matrice de transition est donnee par: 
ll Tl 



= r 1 

Lo lJ 



(1.48) 



Ou T presente le temps entre deux mesures, appelee aussi le temps de mise a jour. 

Le terme G k u k est introduit afin de prendre en consideration les fluctuations de vitesse. 

u k est suppose etre une valeur scalaire, blanche de moyenne nulle et de variance G p , qui 

represente l'acceleration supposee constante durant la k eme periode d'echantillonnage. On a: 



G = 



T 2 

T T 



(1.49) 



E[u(k)u T (l)] = a 2 p 6(k, 1) (1.50) 



etQ(k) = K[Gu(k)u T (l)G T ] = 



!t4 iyS 
4 2 



(1.51) 



II n'existe pas de regie pour le choix de a p . On peut cependant le choisir de fagon empirique de 
l'ordre de grandeur de l'acceleration maximal a M :0.5 a M < a p < a M 

4.2 Modele a acceleration constante (troisieme ordre) 

Ce modele est approprie au mouvement d'une cible manoeuvrante. II suppose que l'acceleration est 
constante et utilise un bruit de processus pour modeliser ses fluctuations eventuelles. L'equation 
d'etat correspondant a ce modele est similaire a l'equation (1.47) . 

Les composantes du vecteur d'etat x(k) sont dans ce cas: la vitesse et l'acceleration. 

x k = [x,x,x] T (1.52) 
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La matrice de transition F k est donnee par: 
1 



F = 



1 T -T 2 
2 

1 T 
1 



(1.53) 



Les fluctuations de l'acceleration sont modelisees par le bruit de processusG(k)v(k), ou v(k) 
represente l'increment de l'acceleration durant la k eme periode d'observation. 



II est suppose une sequence blanche de moyenne nulle avec une varianc <T v V avec: 



G = 



T 2 

— T 1 

2 



(1.54) 



La matrice de covariance du bruit de processus est donnee par 



Q(k) = 



"1 j4 

4 

2 
T 2 

— T 

■ 2 



r2 n 

2 2 



1-3 T ' 



T 
1 



(1.55) 



Les changements de l'acceleration sont de l'ordre de G v . Pour avoir un modele proche du modele a 
acceleration constante il faut choisir une intensite de bruit G v petite de fagon que les changement de 
l'acceleration A a M pendant une periode restent petits par rapport a l'acceleration actuelle. 

En pratique en prendra: 0.5 A a M < a p < A a M . 
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